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High speed missile inertial reference optical support and re- 
initialising system - derives alignment error estimates from 
comparison of outputs of video camera sensors of reference points 
located on launcher with values from guidance system 
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Sensors mounted on the missile body detect reference points with 
known coordinates. The missile body's orientation is derived from 
the sensor signals and compared with that produced by the inertial 
reference system. Alignment errors estimated from the results of 
this comparison are used to re-initialise the inertial reference 
system. 

The missile body can be fired from a weapon launcher on which 
the reference points are arranged. In this case the sensors view in 
the opposite direction to the flight direction. For an unpowered 
guided weapon system, the guided weapon forms the reference 
points and a sensor views in the flight direction and responds to the 
reference points on the weapon. 

ADVANTAGE - Ensures highly accurate alignment of inertial 
reference system nd hence targeting reliability. (15pp Dwg.No.4/9) 
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@ Einrichtung zur Stutzung und Re-lnitialisierung eines Tragheitsreferenzsystems in einem Flugkorper 

© Bei einer Einrichtung zur Stutzung und Re-lnitialisierung 

eines Tragheitsreferenzsystems in einem Flugkorper sind an °" 
dem Flugkorper Sensoren angebracht, welche Referenz- 
punkte mit bekannten Koordtnaten erfassen. In dem Flugkor- 
per sind Mittel zum Bestimmen der Flugkorperposition und 
-lage aus den Sensorinformationen, zum Vergleich der so 
bestimmten Flugkorperposition und -lage mit den von dem 
Tragheitsreferenzsystem gelieferten Werten und zur Bestim- 
mung von Schatzwerten fur Ausrichtfehlern des Tragheitsre- 
ferenzsystems aufgrund dieses Vergleichs vorgesehen. Da- 
bei wird das Tragheitsreferenzsystem mit Hilfe*dieser 
Schatzwerte re-initialisiert. Das kann in der Weise gesche- 
hen, daB der Flugkorper von einem Werfer abschieSbar ist 
und die Referenzpunkte an dem Werfer vorgesehen sind, 
wobei die Sensoren in eine der Flugrichtung entgegenge- 
setzte Richtung "blicken". Alternativ konnen aber auch 
Mittel zum AbschieSen einer nicht angetriebenen Leitmuni- 
tion vorgesehen sein, wobei die Leitmunition eine Folge von 
Referenzpunkten bildet und der Sensor in Flugrichtung 
"blickt" und auf die Folge von Referenzpunkten der Leitmu- 
nition anspricht. 
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Beschreibung 



Die Erfindung betrifft eine Einrichtung zur Stutzung und Re-Initialisierung eines Tragheitsreferenzsystems in 
einem Flugkorper. 

5 Besondere Bedeutung hat die Erfindung bei Hochgeschwindigkeits-FIugkorpern. Solche Flugkorper verfugen 
haufig nicht uber eine Suchkopflenkung. Das ware eine Lenkung, die wahrend des Fluges mittels Sensoren ein 
Ziel beobachtet und den Flugkorper anhand der Sensorsignaie in das Ziel lenkt. Einer solchen Suchkopflenkung 
steht die extrem hohe Geschwindigkeit des Flugkorpers entgegen. Bekannte Kommandolenkverfahren werden 
gestort durch den sehr starken Abgasstrahl des Triebwerkes. Daher erfolgt die Lenkung des Hochgeschwindig- 
10 keits-Flugkorpers ublicherweise mittels eines Tragheitsreferenzsystems. Ein solches Tragheitsreferenzsystem 
liefert inertial Position und Lage des Flugkorpers im Raum. Aus diesen Informationen und der einschlieBlich der 
Entfernung vermessenen Sichtlinie zum Ziel werden Lenksignale erzeugt. Diese Lenksignale fiihren den Flug- 
korper in das Ziel. 

Die Treffgenauigkeit wird dabei von drei EinfluBgrdBen bestimmt, namlich der Genauigkeit der Zielvermes- 
15 sung und Zieipradiktion, der Ausrichtgenauigkeit des Tragheitsreferenzsystems und den Navigationsfehlern 
wahrend des Fluges. Die Ausrichtgenauigkeit und die Navigationsfehler sind direkt uber die Auslegung des 
Tragheitsreferenzsystems beeinfluBbar. 

Bei einer kurzen Flugzeit, wie sie fur Hochgeschwindigkeits-Flugkorper typisch ist, wirken sich sensorbeding- 
te Navigationsfehler relativ schwach aus. Eine Sensordrift fuhrt z. B. wahrend der kurzen Flugzeit nicht zu 
20 wesentlichen Fehlern. Starker ins Gewicht fallen vielmehr vor allem die Ausrichtfehler des Tragheitsreferenzsy- 
stems. Es ist dalier fur solche und ahnliche Anwendungen wichtig, solche Ausrichtfehler mittels eines unabhangi- 
- gen Stutzsystems moglichst genau zu vermessen und zu korrigieren. 

Es ist bekannt, ein in einem Flugkorper eingebautes Tragheitsreferenzsystem (Tochtersystem) dadurch auszu- 
nchten, daB die inertialen MeBdaten dieses Tragheitsreferenzsystems mit den MeBdaten einer in einem Trager- 
25 fahrzeug vorhandenen Tragheitsplattform (Muttersystem) verglichen werden (DE-A-34 45 463). Sowohl das 
Muttersystem als auch das Tochtersystem sind systematischen und zufaliigen Fehlern unterworfen. AuBerdem 
konnen beide Systeme unterschiedlichen Bewegungen ausgesetzt sein. Aus diesem Grund werden fur die 
Ausnchtung komplexe und aufwendige Filteralgorithmen verwendet. Diese Algorithmen benotigen jedoch 
typischerweise mehr als 10 sec Zeit, urn die Ausrichtfehler mit einer Genauigkeit von einigen millirad zu 
30 schatzen. Diese Genauigkeit ist jedoch fur rein tragheitsgeienkte Hochgeschwindigkeits-Flugkorper nicht aus- 
reichend. AuBerdem steht die fur den Algorithmus erforderliche Zeit aus operativen Grunden nicht zur Verfu- 
gung. 

Der Erfindung liegt die Aufgabe zugrunde. die Treffsicherheit von Flugkorpern zu verbessern. 
Der Erfindung liegt insbesondere die Aufgabe zugrunde, eine hochgenaue Ausrichtung eines Tragheitsrefe- 
35 renzsystems bei einem Hochgeschwindigkeits-FIugkorper zu ermoglichen. 

ErfindungsgemaB wird diese Aufgabe dadurch gelost, daB an dem Flugkorper Sensoren angebracht sind, 
welche Referenzpunkte mit bekannten Koordinaten erfassen und in dem Flugkorper Mittel zum Bestimmen der 
Flugkorperposition und -lage aus den Sensorinformationen, zum Vergleich der so bestimmten Flugkorperposi- 
tion und -lage mit den von dem Tragheitsreferenzsystem gelieferten Werten und zur Bestimmung von Schatz- 
40 werten von Ausrichtfehlern des Tragheitsreferenzsystems aufgrund dieses Vergleichs vorgesehen sind, wobei 
das Tragheitsreferenzsystem mit Hilfe dieser Schatzwerte re-initialisiert wird. 

Nach der Erfindung erfolgt somit eine Stutzung des Tragheitsreferenzsystems unmittelbar nach dem Start 
durch eine unabhangige, optische Stutzeinrichtung. Zu diesem Zweck werden unmittelbar nach dem Start die 
Referenzpunkte von den flugkorperfesten Sensoren angepeilt. Daraus wird die Position und Lage des Flugkor- 
45 pers bezogen auf ein Navigations- Koordinatensystem bestimmt. Diese Messungen wef*den in der Anfangsphase 
der Fiugbahn. etwa bis zu einem Flugweg von 10 bis 20 m mit hoher Datenrate standig wiederholt. Es wird so die 
Position und Lage des Flugkorpers mittels der optischen Stutzeinrichtung bestimmt. Aus den MeBdaten des 
Tragheitsreferenzsystems kann auf die Ausrichtfehler des Tragheitsreferenzsystems geschlossen werden. Diese 
Ausrichtfehler werden im weiteren Verlauf des Fluges beriicksichtigt. 
50 Ausgestaltungen der Erfindung sind nachstehend unter Bezugnahme auf die zugehorigen Zeichnungen naher 
erlautert. 

Fig. 1 zeigt schematisch einen Werfer fur einen Flugkorper mit Referenzpunkten zur Ausrichtung des Trag- 
heitsreferenzsystems eines Flugkorpers. - 

Fig. 2 veranschaulicht geometrische Verhaltnisse bei der Zielvermessung. 
55 Fig. 3 zeigt schematisch einen Flugkorper mit einem Tragheitsreferenzsystem und Sensoren zum Erfassen 
von Referenzpunkten an dem Werfer. 

Fig. 4 ist ein Blockdiagramm und veranschaulicht die Signalverarbeitung in dem Flugkorper von Ftg. 3. 

Fig. 5 ist eine perspektivische Darstellung und veranschaulicht die Sichtlinie des Sensors zu dem Referenz- 
punkt in einem flugkorperfesten Koordinatensystem. 
60 Fig. 6 zeigt die Lage eines beobachteten Referenzpunktes in einem Sensorgesichtsfeld. 

Fig. 7 ist eine Darstellung iihniich Fig. 3 und zeigt eine abgewandelte Ausfuhrung eines Flugkorpers, bei dem 
die Stutzung und Re-Initialisierung des Tragheitsreferenzsystems mittels einer Leitmunition erfolgt. 

Fig. 8 zeigt einen Werfer zum AbschieBen eines' Flugkorpers nach Fig. 7. 

Fig. 9 zeigt die geometrischen Verhaltnisse bei der Stutzung und Re-Initialisierung des Tragheitsreferenzsy- 
65 stems mittels einer Leitmunition. 

Mit 10 ist in Fig. 1 ein Fahrzeug bezeichnet. Auf dem Fahrzeug 10 sitzt ein Werfer 12. Der Werfer 12 ist mittels 
eines Visiers 14 auf ein Ziel 16 ausrichtbar. An dem Werfer 12 sind mindestens zwei Referenzpunkte 18 und 20 
vorgesehen. 
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Der Werfer 12 ist zum Abfeuern eines Hochgeschwindigkeits-Flugkorpers 22 eingerichtet. Der Hochge- 
schwindigkeits-Flugkorper 22 weist mindestens zwei Sensoren 24 und 26 auf, welche die Referenzpunkte 18 bzw. 
20 erfassen und entsprechende Lageinformationen liefern. Die Sensoren 24 und 26 sind hochaufiosende, bilder- 
fassende Sensoren. Praktisch sind die Sensoren hochauflosende Videokameras. Die Sensoren 24 und 26 "blicken" 
bei der Ausfuhrungsform von Fig. 3 ruckwarts, also entgegen der Flugrichtung. Der Flugkorper 22 enthalt 5 
weiterhin ein Tragheitsreferenzsystem 28. 

Die Signale der bilderfassenden Sensoren 24 und 26 dienen dazu, das Tragheitsreferenzsystem zu stutzen und 
zu reinitiaiisieren. Das geschieht in der in Fig. 4 dargestellten Weise. 

Zur Beschreibung werden verschiedene Koordinatensysteme benutzt, die durch verschiedene lndizes unter- 
schiedensind: 10 

(v) — Visierkoordinatensystem, 
(w) — Werferkoordinatensystem, . 
.(n) — Navigationskoordinatensystem, 

(b) — Flugkorperkoordinatensystem, 15 
(s) — Sensorkoordinatensystem. 

Das Visierkoordinatensystem ist aus Fig. 1 ersichtlich: Das Visierkoordinatensystem enthalt die Koordinaten- 
achse x v und die dazu senkrecht in der Papierebene von Fig. 1 verlaufende Koordinatenachse y v . Die Koordina- 
tenachse x v ist dabei die Visierlinie. Die dritte Koordinatenachse z v dieses Koordinatensystems ist senkrecht zu 20 
den andere"n beiden Koordinatenachsen. In entsprechender Weise ist das Werferkoordinatensystem aus Fig. 1 
ersichtlich. Das Werferkoordinatensystem enthalt die Koordinatenachse x w . Das ist die Rohrachse des Werfers 
12. Die Koordinatenachse y w liegt senkrecht dazu wieder in der Papierebene von Fig. 1. Die dritte Koordinaten- 
achse z w verlauft senkrecht zu diesen beiden Achsen. Das Navigationskoordinatensystem ist ein (nicht darge- 
stelltes) erdfestes Koordinatensystem, das bei korrekter Ausrichtung mit dem Werfersystem zusammenfallt. Das 25 
mit dem Index "b" bezeichnete Flugkorperkoordinatensystem ist aus Fig. 3 ersichtlich. Das Flugkorperkoordina- 
tensystem enthalt als Xb*Achse die Flugkorperlangsachse. Die yb-Achse ist die dazu senkrechte Querachse in der 
Papierebene von Fig. 3. Die dritte Achse, die Zb*Achse verlauft senkrecht zu den beiden vorerwahnten Achsen 
und senkrecht zur Papierebene von Fig. 3. Das Sensorkoordinatensystem enthalt die Blickrichtung des jeweili- 
gen Sensors 24 bzw. 26 als Koordinatenachse x s . Das ist am besten aus Fig. 5 ersichtlich. Die beiden anderen 30 
Koordinatenachsen y s und z s des Sensorkoordinatensystems verlaufen parallel zu den Seiten des rechteckigen 
Sensorgesichtsfeldes 30, wie am besten aus Fig. 6 ersichtlich ist. Die Sichtlinie 32 von dem Sensor 24 oder 26 zu 
dem zugehorigen feststehenden Referenzpunkt 18 bzw. 20 kann durch zwei Winkel definiert werden, wie in 
Fig. 5 dargestellt ist, oder durch die Koordinaten in dem Gesichtsfeld 30 gemaB Fig. 6. 

Ein Ziel 16 wird iiber das Visier 14 identifiziert. Die Sichtlinie rr vom Visier 14 zum Ziel 16 wird nach Richtung 35 
und Lange bestimmt. Die Lange der Sichtlinie, also die Entfernung zum Ziel 16, wird dabei mittels eines 
Laser-Entfernungsmessers gemessen. Das Visier 14 ist gegeniiber dem Ursprung des Werferkoordinatensystems 
seitlich urn einen Vektor rv versetzt. GemaB Fig. 2 ergibt sich die Sichtlinie rwT zum Ziel im Werferkoordinaten- 
system. Auf diese Sichtlinie wird zunachst das Tragheitsreferenzsystem 28 des Flugkorpers 22 initiaiisiert. 

Nach dem Start des Flugkorpers 22 werden mit Hilfe der vom Tragheitsreferenzsystem 28 gelieferten 40 
Inertialdaten laufend die Position des Sensors 24 oder 26 und die Position des zugehorigen Referenzpunktes 18 
bzw. 20 im Navigationskoordinatensystem ermitteit. Der Vektor R von dem Referenzpunkt 18 oder 20 zu dem 
zugehorigen Sensor 24 bzw. 26 ist. 



Zwischen dem Werferkoordinatensystem und dem Navigationskoordinatensystem sind unbekannte Ausricht- 
fehler und zu berucksichtigen. Es gilt: 



R n = r n -r s n . 



(1) 
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r n = C n w r w . 



(2) 
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Dabei ist 
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die Transformationsmatrix 3 
Pie Ausricbtfehler werden a 
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AG = 0 (4) 
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Tragheitsreferenzsystem 28 liefert aulier dem Ort des Flugkorpers 22 zusatzlich auch die Geschwindig- 



3 



keit und die Beschleunigung: 



r" = v n 
- s - s 



(5) 



- s — b — s —s 



(6) 



Hierbei ist Cb n die vom Tragheitsreferenzsystem ermittelte Transformationsmatrix von dem Flugkorperkoor- 
dinatensystem zu dem Navigationskoordinatensystem, a s n ist die von dem Tragheitsreferenzsystem 28 gemesse- 
ne Beschleunigung des Flugkorpers 22 transformiert in das Navigationskoordinatensystem. 

Die Gleichungen (4), (5) und (6) bilden eine Zustandsgleichung mit dem Zustandsvektor 

x = (r s , v s ,A\j/, A0) 
undeinem Eingangsvektor. 



AIs beobachtbare AusgangsgroBen stehen die Einheitsvektoren der Sichtlinien 32 von dem Sensor 24 oder 26 
zu den zugehongen werferfesten Referenzpunkten 18 bzw. 20 zur Verfugung. Im Navigationskoordinatensy- 
stem ist ein solcher Einheitsvektor gegeben durch. 



Mit den Gleichungen (4) bis (7) laBt sich ein Kalman-Filter mit nichtlinearer MeBgleichung realisieren, mit dem 
die unbekannten Ausrichtfehler A4> und AO geschatzt werden konnen. Durch die Verwendung von mindestens 
zwei Referenzpunkten kann die Beobachtbarkeit der Ausrichtfehler sichergestellt werden. 

Die Signalverarbeitung ist in Fig. 4 als Blockschaltbild dargestellt. 

Der Sensor 26 liefert Winkel e y s , £ 2 S (Fig. 5), welche die Lage des Referenzpunktes 20 gesehen von dem Sensor 
26 angibt. Diese Winkel e y s , £ z s sirid von dem Vektor R abhangig. Die Winkel sind auf ein Stutzfilter 34 
aufgeschaltet. Das Stutzfilter ist das vorstehend erwahnte Kalman-Filter. Das Stutzfilter erhalt weiterhin von 
dem Tragheitsreferenzsystem 28 die Beschleunigungen des Flugkorpers bezogen auf das Navigationskoordina- 
tensystem. Das Stutzfilter 34 liefert an das Tragheitsreferenzsystem Schatzwerte 



fur die Ausrichtfehler. Das Tragheitsreferenzsystem 28 spricht in ublicher Weise auP~die Drehraten und Be- 
schleunigungen in dem flugkorperfesten Koordinatensystem an. 

Das Tragheitsreferenzsystem liefert einmal Navigationsdaten im Werferkoordinatensystem an ein Lenksy- 
stem 36. Zum anderen liefert das Tragheitsreferenzsystem 28 Autopilotdaten an einen Flugregler 38. Das 
Lenksystem 36 erhalt als "Einweisung" die Sichtlinie zum Ziel in dem Werferkoordinatensystem. Das Lenksy- 
stem liefert aus dieser Sichtlinie und den Navigationsdaten Kommandos fiir den Flugregler 38. Der Flugregler38 
liefert Ruderkomrnandos. 

Die beschriebene Signalverarbeitung arbeitet wie folgt: 

Bei Flugbeginn werden die Ausrichtfehler zunachst mit null angenommen. Das Navigations- und das Werfer- 
koordinatensystem waren dann zunachst identisch. 

Sobald die Richtung zu den Referenzpunkten 18 und 20 vermessen werden kann und die Sensoren 24 bzw. 26 
die liefern. beginnt das Stutzfilter 34 mit einer Schatzung der Ausrichtfehler A4* und AG. Als MeBwerte stehen 
primar die gemessenen Ablagen der Referenzpunkte in den Gesichtsfeldern 30 (Fig. 6) der Sensoren 24 und 26 
zur Verfugung. 

Die Richtung der Sichtlinie ist im Sensorkoordinatensystem (s) wie folgt definiert: 



u = a s l \ 




(7) 



- s 

s R y 

Z = arctg, 

z - s 



_ s 

s R z (8) 
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Darin sind R y und R 2 die Koordinaten der Sichtlinie 32 in den Gesichtsfeidern 30 der Sensoren 24 oder 26. R x 
ist der Abstand der Ebene des Sensors von der Ebene der Referenzpunkte 18, 20. Fur die Komponenten des 
£ichtlinienvektors ergibt sich dann: 

15 



P S = COS £ " COS £ 

x y z 



R s = cos z S y sin Z * 
R z = -sin £ y 

Aus der bekannten Ausrichtung des Sensors 24 oder 26 zum Flugkorper 22, die durch eine Transformations- 
matrix C s b dargestellt ist, und der von dem Tragheitsreferenzsystem 28 her bekannten Transformationsmatrix 
Cb n ergibt sich 

Cs n = c b n c s b . (io) 30 

Damit kann die im Sensorkoordinatensystem vermessene Sichtlinie R in das Navigationskoordinatensystem 
transformiert werden. Es ergibt sich: 

RP = C s n R s . (11) 35 

Damit kann der Sichtlinienvektor auf das Stutzfilter, d. h. den Kalman-Filteralgorithmus, aufgeschaltet wer- 
.den. Die MeBwerte fur den Sichtlinienvektor werden mit den aufgrund der bekannten Lage der Referenzpunkte 
und den Navigationsdaten zu erwartenden Ablagen im Gesichtsfeld verglichen. Daraus schatzt der Kalman-Fil- 40 
teralgorithmus die Ausrichtfehler. Diese Ausrichtfehler sind als KorrekturgroBen auf das Tragheitsreferenzsy- 
stem 28 aufgeschaltet. Dieses Tragheitsreferenzsystem 28 iiefert seinerseits verbesserte Navigationsdaten an das 
Lenksystem 36. 

Das Lenksystem vergleicht die im Werferkoordinatensystem vorliegende Sichtlinie mit den Navigationsdaten 
und bestimmt aus diesem Vergleich die Autopilotkommandos fur den Flugregler 38. Der^Flugregler bildet 45 
daraus und aus den von dem Tragheitsreferenzsystem 28 gelieferten Autopilotdaten geeignete Ruderkomman- 
dos, durch welche der Flugkorper 22 auf der eingewiesenen Sichtlinie gefiihrt wird. 

Bei der unter Bezugnahme auf die Fig. 1 bis 6 beschriebenen Einrichtung sind die Referenzpunkte zur 
Stiitzung und Reinitialisierung des Tragheitsreferenzsysterns feststehend an dem Werfer angebracht. Die Refe- 
renzpunkte befinden sich auBerdem hinter dem Flugkorper. Dadurch ist die Zeitspanne, wahrend welcher die 50 
Referenzpunkte beobachtet werden konnen, relativ kurz. Auch kann die Beobachtung u. U. durch deri Abgass- 
trahl des Triebwerkes beeintrachtigt werden. In solchen Fallen konnen Mittel zum AbschieBen einer nicht 
angetriebenen Leitmunition vorgesehen sein. wobei die Leitmunition Referenzpunkte bildet und der Sensor in 
Flugrichtung "blickt" und auf die Referenzpunkte der Leitmunition anspricht. Solche nicht-angetriebene Leitmu- 
nition, z. B. eine heiBe und daher im Infraroten strahlende Kugel, fiihrt eine definierte Bewegung aus. Das ist 55 
anders als bei einem angetriebenen Flugkorper, wo durch den Antrieb Bahnschwankungen auftreten konnen. 
Diese kurz vor dem AbschuB des Flugkorpers abgeschossene Leitmunition bildet dann eine Folge von Referenz- 
punkten. Diese Folge von Referenzpunkten wird durch einen Sensor des Flugkorpers in Flugrichtung des 
Flugkorpers beobachtet. Das kann fur eine langere Zeit geschehen. Da die Flugbahn und der Zeitverlauf des 
Fluges der Leitmunition reproduzierbar und bekannt sind, kann ein solcher beweglicher Referenzpunkt eben- 6 o 
falls benutzt werden, urn das Tragheitsreferenzsystem zu stiitzen und zu re-initialisieren. 
* Eine solche Einrichtung ist nachstehend unter Bezugnahme auf die Fig. 7 bis 9 naher erlautert. 

Der Aufbau der Einrichtung ist in mancher Hinsicht ahnlich wie bei der Ausfuhrung von Fig. 1 bis 6. 
Entsprechende Teile sind mit den gleichen Bezugszeichen versehen wie dort. 

. Der Werfer 12 weist bei der Ausfuhrung von Fig. 7 bis 9 keine Referenzpunkte auf. Statt dessen ist eine 6 5 
Vornchtung 40 zum AbschuB einer Leitmunition vorgesehen. Die Leitmunition kann von einer heiBen Kugel 
gebildet sein. An dem Flugkorper ist ein Sensor 42 angebracht. Der Sensor 42 ist ebenfalls ein hochauflosender. 
bilderfassender Sensor, der im Infraroten arbeitet. Der Sensor 42 "blickr nach vorn in Flugrichtung des 



20 
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Flugkorpers 22. Der Sensor 42 ist zum Erfassen der Leitmunition eingerichtet. Der Sensor 42 erfaBt die 
Leitmunition so lange, bis die Ausrichtfehier mit hinreichender Genauigkeit ermittelt sind. 

Zur mathematischen Beschreibung des Verfahrens werden die gleichen Koordinatensysteme benutzt, die auch 
bei dem Ausfuhrungsbeispiel von Fig. 1 bis 6 benutzt wurden. In Fig. 9 ist die Geometrie der einzelnen Vektoren 
skizziert. 

In Fig. 9 ist der Werfer 12 dargestellt. Der Werfer 12 schieBt mittels der Vorrichtung 40 (Fig. 8) eine 
Leitmunition 44 in Form einer erhitzten Kugel ab. Die Leitmunition 44 folgt einer vorbestimmten Bahn mit 
vorgegebenem zeitlichen Ablauf. Der Ortsvektor der Leitmunition 44 bezogen auf den Werfer 12 ist mit rt 
bezeichnet. In Fig. 9 ist weiterhin die tatsachliche Position des Flugkorpers 22 dargestellt. Der Ortsvektor dieser 
tatsachlichen Position ist mit r s bezeichnet. Von dem Flugkorper 22 zu der Leitmunition 44 ergibt sich eine 
Sichtlinie, die durch einen Vektor tm dargestellt ist. Das Tragheitsreferenzsystem 28 liefert eine von der 
tatsachlichen Position abweichende Position 46. Diese Position ist durch einen Ortsvektor tse bezogen auf den 
Werfer 12 gekennzeichnet. Von der durch das Tragheitsreferenzsystem 28 angezeigten"Position 46 zu der 
Leitmunition 44 ware eine Sichtlinie zu erwarten, die durch einen Vektor te dargestellt wird. Der Navigations- 
fehler ist ein Vektor, der mit Ar bezeichnet ist und der von der tatsachlichen Position des Flugkorpers 22 zu der 
angezeigten Position 44 verlauft. 

Der von dem Sensor 42 gemessene Sichtlinienvektor tm zu der Leitmunition weicht von dem erwarteten 
Sichtlinienvektor urn den Navigationsfehler Ar ab: 

20 £M = £E + A r . (12) 

Die Ausrichtfehier und zwischen dem Werferkoordinatensystem und dem Navigationskoordinatensystem 
werden als konstante, unbekannte GroBen angenommen. Das ist genauso wie bei dem Ausfuhrungsbeispiel von 
Fig. 1 bis 6. Es ist. 
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(g = [A\|/,A0,O] T (13) 
2 = 0 (14) 

Die Transformation zwischen Werferkoordinatensystem und Navigationskoordinatensystem kann fur kleine 
Winkel zu 
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(15) 



angenommen werden. Der erwartete Vektor der Sichtlinie von Punkt 46 zur Leitmunition 44 ist 
r E n - r L n - r S E n - c w n r L w - r SE n (16) 

Damit ergibt sich die MeBgleichung zu a - 
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n _ n w A n n 

£ M = CwiL * A r - Use 



(17) 



Bei dem vorliegenden Stutzproblem geniigt fur das Fehlermodell der Navigation ein stark vereinfachter 
Ansatz: 



55 Ar" 
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r AV 7 

A* n = A o n 
Cp z 0_ 



(18) 
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wobei 

Aa n = a n x £ (19) 
und 
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a n = C b n a b (20) 

C b n ist die vom Tragheitsreferenzsystem ermittelte Transformationsmatrix zwischen dem Flugkorperkoordina- 
tensystem und dem Navigationskoordinatensystem. 

Mit dem Zustandsvektor X+[Ar n . Av n , <g] T und der vorstehenden Gleichung (18) laQt sich ein lineares, 
zeitvanantes ICalman Filter aufbauen. Die MeBgleichung (17) ist nichtiinear, da nur die Richtung des Vektors r M 
meSbar ist: - 



r n W A 0 n 

~\ (21) 
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Die Beziehung zwischen den gemessenen Ablagen e y s und e z s im Sensorkoordinatensystem und den Kompo- 15 
nenten des Sichtlinienvektors ist wie folgt definiert: 



z s - arctg. ' ' M Y 



2 ^ S 

r Mx 



s x r Mz 
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(22) 



Z y =-arctg 



Mx My 
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S 5 S S 

r Mx = C0S Zy cos * z 

r My = Cos E y s ' n € z 35 

F Mz = ~ sin £S 



40 

Mit der bekannten Transformationsmatrix 
C 5 n = Cb n C s b 

45 

lassen sich die Komponenten tm s in das Navigationskoordinatensystem transformieren: 
rM n = Cs n r M s (23) 

Somit liegt zwischen den primaren MeBgroBen und den ZustandsgroBen des Kalman-Filters eine nichtlineare 50 
Beziehung vor: 

Z = tm" (24) 

Die MeBgleichung (24) ist bei der Filterauslegung, abhangig von dem zu verwendenden Sensor 42, noch urn 55 
einem Rauschanteil zu erweitern. 

Die Signalverarbeitung ist prinzipiell in der gleichen Weise aufgebaut wie es bei dem Ausfuhrungsbeispiel 
nach Fig. 1 bis 6 in Fig. 4 dargestellt ist. Unterschiedlich ist lediglich die Ausfuhrung des Stutzfilters 34 wie 
vorstehend erlautert. Auch die Fig. 5 und 6 des Ausfiihrungsbeispiels von Fig. 1 bis 6 geiten in gleicher Weise fur 
die Beobachtung der Leitmunition mittels des Sensors 42. 



Patentanspniche 

1. Einrichtung zur Stutzung und Re-lnitialisierung eines Tragheitsreferenzsystems (28) in einem Flugkorper 
(22), dadurch gekennzeichnet, daB an dem Flugkorper (22) Sensoren (24, 26; 42) angebracht sind. weiche 
Referenzpunkte (18. 20: 44) mit bekannten Koordinaten erfassen und in dem Flugkorper (22) Mittel zum 
Bestimmen der Flugkorperlage aus den Sensorinformationen, zum Vergleich der so bestimmten Flugkor- 
perlage mit den von dem Tragheitsreferenzsystem (28) gelieferten Werten und zur Bestimmung von 



60 



65 
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Schatzwerten fur Ausnchtfehlern des Tragheitsreferenzsystems (28) aufgrund dieses Vergleichs vorgese- 
hen sind wobei das Tragheitsreferenzsystem (28) mit Hilfe dieser Schatzwerte reinitialisiert wird 
2 Einnchtung nach Anspruch 1, dadurch gekennzeichnet, daB der Flugkorper (22) von einem Werfer (12) 
abschieBbar ist und die Referenzpunkte (18. 20) an dem Werfer (12) vorgesehen sind. wobei die Sensoren 
(24, 26) in eine der Flugnchtung entgegengesetzte Richtung "blicken". 

3. Einrichtung nach Anspruch 1. dadurch gekennzeichnet, daB Mittel (40) zum AbschieBen einer nicht 
angetnebenen Leitmunition (44) vorgesehen sind, die Leitmunition (44) Referenzpunkte bildet und ein 
Sensor (42) in Flugnchtung "blickt" und auf den Referenzpunkt der Leitmunition (44) anspricht. 

4. Einnchtung nach einem der Anspruche 1 bis 3. dadurch gekennzeichnet, daB die Sensoren von hochauflo- 
senden, bilderfassenden Sensoren gebildet sind. 



Hierzu 7 Seite(n) Zeichnungen 
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Fig. 3 
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